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invention a trait a un procede et a un dispositif de 
commande des deplacements d'une partie mobile d'un robot 
multi-axes le long d'une trajectoire. 

Dans le domaine de la commande des robots multi-axes, il 
5 est connu de commander un robot multi-axes grace k des 
boucles d' asservissement de type PID (proportionnelle 
integrale derivee) en position, vitesse et courant, afin de 
faire evoluer la partie terminale d'un robot, qui peut porter 
un outil ou un prehenseur, sur une trajectoire de geometrie 

10 et de profil de vitesse determines, II est egalement connu de 
commander un tel robot en diminuant la raideur 
d' asservissement sur chaque axe, afin de permettre une 
variation de la position du bras en fonction des efforts 
d' interaction entre les parties mobiles du robot et leur 

15 environnement . II est en particulier connu, par exemple" de 
US-A-5, 742, 138, de parametrer la raideur d'un bras de robot 
multi-axes dans un systeme de coordonnes rectangulaires, 
mesurer une erreur de position, de calculer un effort et.vde 
corriger la position de la partie mobile du robot a:^ " 

20 d'obtenir une certaine souplesse de I'organe terminal. Une 
telle souplesse peut etre utilis6e pour realiser des 
operations de manipulation de pieces telle qu'un polissage, 
un ebavurage ou le dechargement d'une presse pour lesquels un 
effort de contact peut contrarier le raouvement programme du 

2 5 robot • 

II est egalement connu de donner un effort de consigne 
dans un systdme de coordonnees rectangulaires afin de 
realiser une operation a . effort controle le long d'une 
trajectoire, par exemple pour une operation d' ebavurage ou de 
30 polissage. 

Dans les systemes connus, on prevoit parfois que 
1' interface de programmation de trajectoire permette de 
specifier des parametres tels que la vitesse ou 
1' acceleration de la partie mobile sur sa trajectoire, ces 
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paramdtres detearminant la position de la partie terminals du 
bras du robot le long de sa trajectoire en fonction du temps. 

II est ggalement connu de US-A-4 , 874, 997 de controler de 
tagon numerique un moteur barushless d' articulation de robot 
par modulation de largeur d' impulsions . 

Dans les systdraes connus, il n'est pas possible de 
programmer de fagon aisge un robot multi-axes pour que la 
trajectoire de deplacement de sa partie terminale puisse gtre 
contrei^e en vitesse et accgl^ration d'une part, et en effort 
tangentiel a la trajectoire du point de contact de sa partie 
mobile avec son envi ronnement d' autre part, tout en 
respectant des valeurs de vitesse et d' acceleration 
compatibles avec la structure mecanique du robot. 

C'est a ces inconv^nients qu'entend plus 
15 particulidrement rem^dier 1' invention en proposant un precede 
dans lequel les interactions avec 1 ' envi ronnement de la 
partie mobile d'un robot, notamment une piece ou un outil 
porte par celui-ci, sont controlees avec precision. 

Dans cet esprit, 1' invention conceme un precede de 
commande des deplacements d'une partie mobile d'un robot 
mult i -axes le long d'lme trajectoire dans lequel sont des 
prSvues des Stapes consistant a : 

fournir a tin g^nerateur de trajectoire des 
instructions de mouvements incluant au moins des informations 
relatives a la geometric de la trajectoire et a des consignes 
d' effort ; 

- calculer xin signal dit d' effort extSrieur reprgsentant 
au moins une composante de 1' effort exercg par la partie 
mobile sur son environnement ; 

" fournir, a une frequence d' gchantillonnage 
predeterminee, le signal d' effort extgrieur. au g^nerateur de 
trajectoire ; 

- calculer, au moyen du generateur de trajectoire et a 
une frequence d' gchantillonnage predeterminee, des consignes 



20 



25 



de mouvement de fa<?on a minimiser I'ecart entre la projection 
de 1' effort exterieur sur la tangente a la trajectoire et la 
projection de la consigne sur cette tangente ; et 

fournir les consignes de mouvement a un moyen 
d'asservissement qui permet de mettre en mouvement au moins 
un axe du robot conformement §l ces consignes. 

L'asservissement en effort tangentiel permet done de 
conserver la g^om^trie de la trajectoire, tout en adaptant la 
Vitesse de la partie mobile sur cette trajectoire, 

Selon des aspects avantageiix, un precede de commande des 
dSplacements d'une partie mobile d'un robot multi-axes peut 
incorporer xine ou plusieurs des caracteristiques suivantes : 

- Le signal d' effort exterieur est calcule a partir 
d'une information representant le courant circulant dans au 
moins un actionneur du robot • 

- II est prevu une etape consistant a utiliser un modele 
dynamique du robot lors du calcul du signal d' efforts 
exterieur . 

II est prevu une etape consistant IL fournir au 
generateur de trajectoire au moins une valeur limite d^ 
Vitesse et/ou une valeur limite d' acceleration pour prise en 
compte lors du calcul des consignes de mouvement, de telle 
sorte que ces consignes soient conformes a cette ou ces 

valeurs limites. 

L' invention concerne egalement un dispositif permettant 
de mettre en oeuvre un precede decrit ci~dessus et, plus 
spef iciquement, un dispositif qui comprend : 

- un generateur de trajectoire apte a calculer des 
consignes de mouvements en fonction d' instruction de 
mouvements incluant au moins des informations relatives & la 
geometrie de la trajectoire et a des consignes d' efforts et 

- xxa estimateur d' effort apte a generer un signal 
d' effort exterieur representant au moins une composante de 
1' effort exercee par la partie mobile sur son environnement 
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et a fournir ce signal au ggn^rateur de trajectoire, a une 
frequence d' echantillonnage predetermin6e, 

alors que le generateur de trajectoire est apte a calculer 
les consignes de mouvements. It une frequence 
5 d' Echantillonnage predeterminee, de fa?on a minimiser I'ecart 
entre la projection de 1' effort exterieur sur la tangente et 
la trajectoire et la projection de la conaigne d' effort sur 
cette tangente, ces consignes de mouvement etant fournies t 
un tnoyen d' asservissetnent permettant de mettre en mouvement 
1 0 au mo ins un axe du robot . 

De fa9on avantageuse, ce dispositif comprend un moyen 
interpreteur de programmes apte a executer des programmes qui 
comportent des instructions" de mouvements permettant de 
specifier au moins la ggora^trie de la trajectoire et des 
15 consignes d' efforts. 

L' invention sera mieux conprise et d'autres avantages de 
celle-ci apparaitront plus clairement a la lumidre de la 
description qui va suivre d'un mode de realisation d'un 
procedg conforme §. son principe, donne uniquement a titre 
d' example et fait en reference aux dessins annexes dans 
lesquels : 

- La figure 1 est une representation sch^matique de 
principe d'un robot multi-axes en train de deplacer une 
f raise le long d'une trajectoire, grace ^ xm precede conforme 

25 a 1' invention. 

- La figure 2 est une representation schematique de 
principe de la repartition des efforts au niveau d'une partie 
mobile du robot de la figure 1. 

- La figure 3 est un schgma-bloc de principe 
representant le f onctionnement general de 1' invention ; 

- La figure 4 est un schema-bloc de principe 
representant le transfert des consignes de position au 
systdme d' asservissement correspondant pour chaque moteur ; 
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La figure 5 est un schema-bloc de principe 
representant 1 ' asservissement de chaque moteur ; 

- La figure 6 est une representation de la methode 
utilisee pour estimer les efforts exterieurs et 
5 - La figure 7 represente 1 ' algor ithme utilise par 

le generateur de trajectoire pour generer les consignes de 
mouvement s . 

Le robot R represente a la figure 1 est un robot multi- 
axes a six articulations. II pent evoluer avec six degres de 
10 libert6. Le robot R peut etre commande en mode cartesien, 
auquel cas ses degres de liberte peuvent Stre trois degres de 
liberte en translation selon la direction de trois axes X, Y 
et Z et trois degres de liberte en rotation Rx/ RyV et Rz 
autour des axes precites. Le robot R peut egalement etre 
15 commande en mode articulaire, auquel cas ses degres de 
liberte peuvent etre six rotations Ri, R2/ Rs/ R5 et R^, 

autour de ses six axes d' articulation Xi, X2, X3, X4, X5 et Xs . l 

Ce robot est associ^ §l une unite de commande U qui^vf 
controle son f onctionnement pendant les phases^^^ 
20 d' apprentissage et d' utilisation, 

Un boltier B de commande manuelle peut egalement §tre 
utilise pendant les phases d' apprentissage . • 

Dans I'exemple represente, le robot R porte un outil O, 
tel qu'une f raise, qu'il convient de deplacer selon une 

25 trajectoire T. 

Comme il ressort plus particulierement de la figure 2, 
on considdre que 1' outil O est deplace par le robot R le long 
du bord Bi d'une pi^ce S f raiser. La trajectoire T est 
globalement parallele a ce bord. On note F 1' effort exerc6 

30 par 1' outil O sur le bord Bi- On note Ft la composante de cet 
effort tangente a la trajectoire T et Fn la composante de cet 
effort normale a la trajectoire T. 

* 
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Conform^ment a 1' invention, on utilise la valeur de la 
composante Ft dans le precede de commande des deplacements de 
I'outil O. 

Dans la descriptif suivant Fext est utilise au sens 
5 large et repesente le vecteur des couples articulaires du 
bras robot ou le torseur des effort exterieurs integrant les 
efforts cartesiens Fx,Fy,Fz, et les couples cartesiens 
Mx, My, Mz . 

Comme represent^ k la figure 3 1 ' environnement de 
10 programmation 100 permet a 1 ' utilisateur du systems de 
programmer le robot de maniere a ce qu'il realise les 
operations souhait^es. Ces operations sont decrites par des 
•programmes. ' L ' envi ronnement de programmation permet 
d'apprendre les positions successives que doit atteindre le 
robot, d'ecrire les programmes decrivant 1 ' enchainement des 
mouvements, de mettre au point ces programmes, de demarrer 
leur execution, de les arret er, etc™ 

Pour exgcuter les programmes, 1 ' environnement de 
programmation fait appel. a un interpreteur de programmes 200. 
Celui-ci execute les programmes destines a r^aliser une tache 
par le robot. Les programmes ex^cut^s contiennent, entre 
autre, des instructions 300, dites instructions de mouvement. 
Elles decrivent les types de mouvements que doit faire le 
robot (ligne droite, cercle,... etc) , ainsi que les different 
25 paramStres les caracterisant (point d'arrivee, Vitesse, 
effort,...) . 

Ces instructions de mouvement 30 0 sont transferees au 
generateur de trajectoire 400. Celui est charge de leur 
execution, c'est-a-dire qu'il doit gSnerer rgguli^rement 
30 (typiquement toutes les 4 millisecondes) , en fonction de leur 
type et de leurs paramdtres, des consignes de mouvement 50 0. 
Ces consignes de mouvement 500 representent la trajectoire 
que doit suivre le robot a chaque instant. Le robot 
industriel asservi 600 comprend un bras industriel a six axes 
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ainsi que son systeme d' asservissement . Le systeme 
d'asservissement est congu de maniere a piloter les six 
moteurs du robot (im pour chaque axe) , de sorte que la 
trajectoire reelle du robot suive au mieux la trajectoire 
definie par les consignes de mouvement 500. 

Dans certaines applications, I'organe terminal du robot 
industriel 60 0 interagit mecaniquement avec son 
environnement : par exemple, la piece qu'il est en train de 
f raiser, L' estimateur d' effort exterieur 700 est un moyen 
d'obtenir un signal, dit effort exterieur 800, representant 
la valeur et la direction des efforts exerces par le robot 
sur son environnement. Ce signal est renvoye au generateur de 
trajectoire 400 en temps r^el (typiquement toutes les 4 
millisecondes) . Ce dernier utilise ce retour d' information 
pour modifier les consignes de mouvement, de manidre ^ 
reguler les efforts d' interactions . 

L' environnement de programmation comporte un boitier de.; 
commande qui permet de deplacer le robot dans un mode 
interactif, de manidre a pouvoir apprendre les differentes. 
positions que devra prendre le robot. II sert aussi.. 
d' interface de programmation pour editer et mettre au point 
les programmes. Le langage utilise pour I'ecriture de ces 
programmes est \xn langage textuel, mais d'autres types de 
langages (graphique par exemple) pourraient §tre utilises 
dans le cadre de cette invention ... 

Le langage utilise contient des instruction courantes 
dans les langages de programmation de robot, qui permet tent 
de specifier differents types de mouvement, de controler leur 
Vitesse et acceleration ainsi que leur enchainements . 

On pr^sente maintenant, 3. titre d' exemple, ici deux 
autres instructions relatives a 1' invention. 

L' instruction : 

MOVE JF (position, outil, params, force) 
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spgcifie que le robot doit deplacer I'outil qu'il porte 
definie par le parametre <c outil ^, depuis la position finale 
du mouvement precedent jusqu'S la position definie par le 
paramdtre position Le d^placement se fait en mode 

articulaire, Cest a dire qu'il y a un rapport de 
proportionnalitg constant entre les deplacements de chaque 
axe durant le mouvement. Le paramdtre « params » specif ie les 
vitesses et accelerations a ne pas dgpasser durant le 
mouvement. II specif ie aussi si le mouvement doit 8tre 
enchaine au mouvement suivant. Enfin, le paramdtre « force » 
specif ie la valeur d^sir^e de 1' effort tangentiel & la 
trajectoire durant le mouvement. Dans la mesure ou les 
■ limit es de vitesse et d' acceleration definies par « params » 
ne sont pas atteintes, le robot doit adapter son deplacement 
le long de la trajectoire de maniere a maintenir la valeur de 
1' effort tangentiel la plus proche possible de la valeur 
specif iee par le parametre « force », 
L' instruction : 

MOVELP (position, outil, params, force) 
est similaire. La seule difference est que le mouvement doit 
s'executer en ligne droite. 

On peut imaginer facilement des instructions similaires, 
definissant des trajectoires circulaires, ou definies par des 
splines ou autres... 

25 II est important pour 1' invention que ces" instructions 

definissent, d'une part, la g^ometrie de la trajectoire que 
doit suivre le robot et, d'autre part, la valeur de I'effort 
tangentiel que doit exercer le robot lors de son deplacement . 

interpret eur de programmes 200 est charge d'executer 

30 les programmes elabores avec 1 ' environnement de 
developpement . Pour executer les instructions de mouvement, 
il verifie la validite des parametres specifies par 
I'utilisateur, puis transmet 1 ' instruction de mouvement 300 
au generateur de trajectoire 400. Les instruction de 
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mouvement 3 00 contiennent les information issues des valeurs 
specif i6es dans le programme, a.savoir : 

- 310 Definition de la ggometrie de la trajectoire : Un 
indicateur indique le type de trajectoire (articulaire ou 
5 ligne droite) . Si le type est « articulaire », les 

coordonnees articulaires qO du point de depart et ql du 
point d'arrivee sont donnees. Si le type est « ligne 
droite », les coordonnees cartesiennes xO du point de 
depart et xl du point d'arrivee sont donnees. 

10 - 320 consigne d' effort tangentiel : II s'agit de la valeur 
desiree fdes de la norme de 1' effort cartesien exerce par 
I'extremite du robot sur son environnement . 
_ Limite de vitesse : valeur limite vmax pour la norme de 

la Vitesse cartesieime de I'extremite du robot, 

15 - 340 liimite d' acceleration : valeur limite amax pour la 
norme de 1 ' acceleration car-tesienne de I'extremite du. 
robot . 

Dans le mode de realisation d^crit ici, les commandes de.>; 
mouvement 500 sont constitutes par les positions angulaires,^;: 

20 qdes des 6 moteurs- Elles sont mise a jour par le generateur 
de trajectoire toutes les 4 millisecondes . Chacune des six 
consignes de position qdesl, qdes2,.. qdes6, est transferee 
au systeme d' asservissement correspondant pour chaque moteur 
601, 602,... 606 comme represents a la figure 4. 

25 Chaque moteur est equipe d'un capteur de position et de 

Vitesse- L'asservissement sur chaque moteur est de type 
proportionnel-integral-dgrive (PID) . A la figure 5, qdes, j 
est la consigne de position sur I'axe j, qmes,j est la 
position mesuree, Kp,j, Ki,j et Kd,j sont les gains 

3 0 respectifs du PID, Ides,j est la consigne de courant, Imes,j 
est le courant mesure, et p est la variable de Laplace. 

D' autre techniques d' asse3rvissement en position peuvent 
aussi ^tre employee dans le cadre de la .presente invention. 
Par exemple, 1 ' asservissement peut etre realise par la 
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technique dite de decouplage et linearisation. Dans ce cas 
I'asservissement n'est plus realise axe par axe. Dans notre 
exemple, les consignes de mouvement 500 sont les position 
angulaires d^sirees pour chaque nioteur. On peut aussi 
utiliser la position et la Vitesse desirees de 1' organe 
terminal, exprim^es dans des coordonnSes cartesiennes . Les 
consignes de mouvement peuvent encore §tre des increments de 
position successifs, ou bien les vitesses d^sir^es sur chaque 
moteur a chaque instant. Le point important pour 1' invention 
est que le generateur de trajectoire 400 calcule en temps 
reel la trajectoire que doit suivre le robot et qu'un systdme 
d'asservissement fait en sorte que le robot suive au mieux 
cette trajectoire. 

De nombreux moyens sont possibles pour estimer 1' effort 
exerce par le robot sur I'exterieur dans le cadre de la 
present e invention. Le plus simple consiste H placer un 
capteur d' efforts a I'extr^rait^ du robot. Dans ce cas, 
1' effort exterieur 800 est exprim^ dans des coordonnees 
cartesiennes. On peut aussi utiliser des capteurs d' efforts 
ou de couples plac^ k diffgrents endroits sur le robot. 

Dans le mode de realisation propose et represents a la 
figure 6, on presente une solution qui permet d' estimer 
1' effort exterieur en utilisant des variables de 
I'asservissement de position. 

La methode utilisee requidre une valeur • 701 reprSsentant 
le courant I circulant dans chaque moteur. Dans notre cas, 
celle-ci est Sgale k la mesure de courant Imes utilisee dans 
le systdme d'asservissement. 

I = Imes = [Imes,l Imes, 2 ... Imes, 6] 

On pourrait aussi bien utiliser la commande de courant, 

soit 

I = Ides = [Ides,l Ides, 2 ... Ides, 6] 
ou toute autre variable, mesurSe ou calculee, reprSsentant 
les courants circulants dans les moteurs . 
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Les moteurs utilise sont des moteurs brushless . Le 
module 702 le plus simple pour ce type de moteur consiste a 
considerer que le couple d^livre Cm 703 est proportionnel au 
courant traversant le moteur, soit : 

5 Cm = Kt . I 

Dans cette expression, I et Cm sont des vecteurs 
contenant les informations relatives a chaque axe et Kt est 
line matrice diagonale. Des modules plus complexes pourraient 
gtre utilises en 702. 

10 D' autre part, la methode utilis6e requiere des signaxxx 

representant les mouvements du robot 711, par exemple les 
positions, vitesses, accelerations de chaque moteur 
repr^sent^s respect ivement par les vecteiirs q, dq/dt et 
d^q/dt^. Dans notre cas, ces valeurs sont deduites des mesures 

15 capteurs utilis6es par le systeme d' asservissement et leux 

d6riv6es . 

q = qmes 

dq/dt = d(qmes)/dt 
d^q/dt^ = d^ (qmes)/dt2 .^i 
20 On pourrait tout aussi utiliser = les consignes d^^ 

positions et leur d^rivees : qdes, d(qdes)/dt, d= (qdes)/dt^. 

* 

A partir des ces informations, et d'un module dynamique 
du bras 712 etabli, par exemple, avec les equations de 
Newton-Euler, on calcule un vecteur Cd representant les 
25 couples qu' exercerait en th^orie chaque moteur du robot, s'il 
n'exergait aucun effort sur I'ext^rieur 713. 

On en dSduit, par difference en 720, vxi vecteur Cext 800 
qui est une estimation des couples moteurs correspondant aux 
efforts exerc^s par le robot sur son environnement 800 : 

30 Cext = Cm - Cd 

La figure 7 montre comment I'algorithme utilise par le 
generateur de trajectoire peut etre decompose en quatre 
parties : 
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A 



partir de la consigne d' effort tangentiel- 310, de 
I'effort exterieur 800 et de la geomgtrie de la courbe 320, 
on calcule en 410 une variable d'erreur scalaire 420. Les 
limitations de vitesse 330 et d' acceleration 340 sont 
projetees en 430 sur la courbe 320. A partir des limites de 
Vitesse et d' acceleration projetees 470 ainsi que de la 
variable d'erreur 420, un regulateur 430 calcule le mouvement 
desire le long de la courbe 440.' Les consignes de mouvement 
du robot 500 sont alors calculees en 450 a partir de la 
definition de la ggom^trie de la courbe 320 et du mouvement 
le long de la courbe 44 0. 

Chacune de ces quatre parties est decrite dans ce qui 

suit . 
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^ - CaJcul de la variable d'erreur (410-420) : cas 
d'un mouvement en ligne droxte 

Le calcul de la variable d'erreur 420 est prgsente ici 
dans le cas d'un mouvement en ligne droite. Les calculs qui 
suivent consistent a calculer la projection sur la courbe 320 
de la difference entre la consigne d' effort 310 et I'effort 
exterieur 800. 

Lors d'un mouvement en ligne droite, la position 
cartesienne x du robot (vecteur) peut gtre. parametree de la 
maniere suivante : 

25 X = xO + s. (xl-xO) 

Oxi XO est le position cartfisienne de depart du mouvement, xl 
est la position cartesienne d' arrives, et s est un paramdtre 
scalaire compris entre 0 et 1 . On peut re-6crire 1' equation 
prec^dente sous la forme 
30 X = f (s) (Eq. 1) 

En derivant cette Equation, on a : 
V = dx/dt = df/ds . ds/dt (Eq. 2) 

Dans cette expression df/ds est un vecteur cartesien 
tangent a la courbe. Le vecteur cartesien 
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u = (df/ds) / I 1 df /ds II 
est unitaire et tangent a la courbe. 

Dans notre example, la consigne d' effort 300 est la 
norme de 1' effort tangent cart^sien. Le vecteur d' effort 
cartesien desire vaut done : 

Fdes = fdes . u (Eq. 3) 

L' effort exterieur 800 est donne par le vecteur des 
couples articulaires Cext. On peut transformer cette valeur 
en coordonnees cartesienne en utilisant la formule suivante : 

Fext = J''' - Cext <Eq. 4) 

oH J-^ est 1' inverse de la transpos6e de la matrice jacobienne 

du robot . 

La variable de commande choisie 420, not^e eps, est la 
difference entre 1' effort tangent d6sir6 et 1' effort 
ext^rieiJir, projete sur la tangente a la trajectoire, soit : 

eps = u*^ . (Fdes - Fext) 

Ce calcul reste valide quel que soit la fonction f 
utilis^e (cercle, spline, ou autre...), dans la mesure ou elle 
est diff^rentiable, ce qui signifie qu'on peut definir sa 

tangente en tout point. 

Ce calcul a et6 conduit dans le cas particulier oil la 
consigne d' effort 300 est la norme d'xan vecteur d' effort 
cartisien et 1' effort exterieur 800 est donne en coordonnees 
articulaires. En utilisant les formules de changement de 
coordonnees ad^quates, par exemple h la place des equations 

m 

Eq. 3 et Eq. 4, on peut traiter les cas ou les ces 
information sont donnees dans n' import e quel systdme de 
coordonnees . 

B - Calcul de la variahle d'erreur (410-420) : cas 

d'un mouvement articula^ire 

Dans le cas d'un mouvement articulaire, la position 
articulaire q du robot peut etre parametree de la maniere 
suivante : 
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q = qO + s. (ql-qO) 
ou qO est la position articulaire de depart du mouvement, ql 
est la position articulaire d'arrivee, et s est un parametre 
scalaire compris entre 0 et 1 . On peut re-ecrire 1' Equation 
precedent e sous la forme 

q = g(s) 

La position cartes ienne correspondante est 
X = k(q(s) ) 

oik k est le modele geom^trique direct du robot. 

.Le mouvement articulaire peut done se traiter comme le 
mouvement cartesien, en choisissant la fonction f telle que : 

f(s) = k(q(s)) 



C - Projection des limites de vitesse et 
15 acceleration le long- de la courbe 460 

Dans notre exemple, les limites de vitesse sont donnees 
en coordonnees cartesiennes . Autrement dit, on souhaite que 
la norme de la vitesse v du robot soit inferieure a une 
Vitesse donnee vmax, et la norme de 1 ' acceleration 
2 0 cartesienne dv/dt soit inferieure a une acceleration donnee 
amax. 

On definit les valeurs suivantes : 

(ds/dt)^^ = min ( vmax / || df/ds || ; c . sqrt (amax / |( df/ds (() (Eq. S) 
(d2s/de}„«^ = ( amax - || df/ds || . (ds/dt)^^ > / II d^f/ds^ (| (Eg, 6) 
25 ou 

c est une constante telle que 0 < c < 1 
sqrtO denote la fonction racine carree 
Supposons qu'on ait : 

I ds/dt I ^ (ds/dt) 
3 0 I d^s/dt^ I ^ (d^s/dt^) 

Alors, d'apres 1' Equation Eq. 2, on a : 

II V II = II df/ds . ds/dt 11 = 11 df/ds II . |ds/dt| 5. II df/ds II . (ds/dt) 

Et done, d'apres Inequation Eq. 5, on a ; 
I I V I I s vmax 



max 



max 



max 



IS 

D' autre part, en d6rivant 1 ' equation Eq. 2, on a 
a = df/ds . d^s/dt^ + d^f/ds^ . (ds/dt)^ 

done 

II a II = II df/ds . d^s/dt^ + 6?f/ds' - (ds/dt)^ || 
S' ^ I I df/ds 1 1 . I d*s/dt^ I + I I d^f /ds= II . I ds/dt I ^ 

S II df/ds II- (dWdt^)«« I + II d^f/dS^ II- (ds/dt) n>ax* 

En utilisant les definitions des Equations Eq. 5 et 

Eq. 6, on obtient : 
I I a I I :s amax 

10 Les valeurs (ds/dt)™ax et (d^s/dt^),^^ dgfinissent done des 

contraintes sur les d^riv6es de s, qui font en sorte que les 
limites de vitesse et d' acceleration cartesiennes sont 
v^rifiees. On peut done considerer que ce sont les 
projections des limites de vitesse et d' acceleration 

15 cartesienne dans les coordonnees de s. 

De manidre similaire, on pourrait avoir des limitations 
de vitesse et/ou d' acceleration articulaire en utilisant la. 
fonction h(s) = k'^Cf (s)) a la place de la fonction f dans les^? 



20 



calculs pr6c6dents- 



D - Regulateur (430) 
Le regulateur 430 a pour rdle de gen€rer des mouvements 
le long de la courbe 440, de maniSre a maintenir la variable 
d'erreur la plus proche de z6ro 420. 
25 Le regulateur utilise est de type integral. Un 

regulateur integral « classique » peut s'exprimer sous la 
forme suivante : 

d(sdes)/dt = K . eps 
sdes = / d(sdes)/dt . dt 
30 ou sdes est la position d^sir^e du robot le long de la 
courbe, exprimee dans les unites du paramdtre s de 1' equation 
Eq. 1, et K une constante. Ceci est repr^sente sur le schema- 
block suivant, ou p designe la variable de Laplace. 
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* 




qps } 


K 


d(sdesVdtj^ 


1 


[ ^ sdes 


(420) I ^ 




P 


1 (440) 













430 



Ce schema est Equivalent k : 



eps 
(420) 

















Kp 


dtsdes>/d^j^ 




dCsdes)^!. 


1 








P 




P 


— {-> 















sdes 
(440) 




430 



Pour 



intggrer les limitations de vitesse et 
d' acceleration, on modifie le schema de la manidre suivante. 



eps 

(420) 




satAccel 



w, 




dfedesVdt 









calcul 

(ds/dt)iijax 





sdes 
(440) 



(430) 



max 



» et « calcul (d^s/dt^) 



max 



» 



Les blocs <K calcul (ds/dt) 
calculent les limites de vitesse et d' acceleration projetees, 
en fonction de sdes, selon les equation Eq. 5 et Eq. 6 (df/ds 
et d f /ds sont Evaluges pour s = sdes) . Le bloc satVel sature 

la Vitesse z en entree en f.onction de (ds/dt) „ax. Autrement 
dit, on a : 



(ds/dt) 



max 



d(sdes)/dt = -< z 

- (ds/dt) „ax 



si 2 > (ds/dt) „ax 

si I z ( s (ds/dt) ^ 
si z '< - (ds/dt) 
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( 



De m§Tne, satAccel sature 1 ' acc616i-ation u en fonction de 

(d^s/dt^).nax, SOit : 



^(d^s/dt2)„.ax Si U > (d^s/dt^) 



max 



W = < 



U si I U I £ (d^s/dt^)max 

2« /^4-2 



- (d^s/dt^)^^ Si u < - (d^s/dt^) 



_ ^ ^^^^ max 



Dans tous les cas, ce schema assure que : 

I d(sdes)/dt | < (ds/dt) max 
ce qui garantit que la norma de la vitesse cartgsienne 
desiree le long de la trajectoire est inf^rieure a vmax. 



= d^ (sdes)/dt2 



Lorsque la vitesse maximale n'est pas atteinte, on a 
z = d{sdes) /dt 

1 5 done 

w 

alors, ' 

I d^ {sdes)/dtM < (d='s/dt^)ro«c 
ce qui garantit que la norme de 1 ' acceleration cartas ienne 

* • 

20 est inferieure k amax. 

Dans un cadre general, 1 ' algorithtne pr^sent^ assure que 
la limite de vitesse cartesienne est toujours respect^e et 
que la limite d' acceleration est respect^e dans la mesure oti 
la vitesse cartesienne maximale n'est pas atteinte. Dans le 

25 cas de la ligne droite, lorsque la limite de vitesse est 
atteinte, 1 ' acceleration est nuile, done la limite 
d' acceleration est respectee . 

E - Calcul (430) des consxgnes de laouvement 500 
30 Dans notre cas, les consignee de mouvement 500 sont les 

coord!onnees articulaires du robot qdes. A partir de la 
position desiree le long de la courbe sdes, on peut calculer 
la consigne de position cartesienne correspondante, grace a 
1' equation parametrique de la courbe Eq. 1- 
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xdes = f{sdes) 

Ensuite, on trouve les coordonnSes articulaires grace ai: 
modele geometrique inverse du robot, note k"^, 

qdes = k"^(xdes) 
Si les consignes de mouvement etaient des vitesses, on 
pourrait utiliser les changement de coordonnees correspondant 
sur les vitesses (Equation Eq. 2 et inverse de la matrice 
jacobienne du robot) . 
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RE VEND I CAT I ONS 

1. Procede de commande des deplacements d'une partie 
5 mobile d'un robot multi-axes le long d'une trajectoire, 

caracterise en ce qu'il comprend des etapes consistcuit ^ : 

- foumir a un generateur de trajectoire (4 00) des 
instructions de mouvement (300) incluant au moins des 
informations relatives a la geometrie de la trajectoire (320) 

10 et a des consignes d' effort (310) ; 

calculer un signal (800) dit d' effort exterieur 
representant au moins une composante de 1' effort (F) exerce 
par ladite partie mobile (O) sur son environnement ; 

foumir, a une frequence d' echantillonnage 
15 predetermin^e, ledit signal d' effort exterieur (800) audit 
generateur de trajectoire (400) ; 

- calculer, au moyen dudit generateux de trajectoire 
(40 0) et a une frequence d' echantillonnage predeterminee, des 
consignes de mouvement (500) de facjon a minimiser I'ecart 

20 entre la projection (Ft) de 1' effort exterieur sur la tangente : 
(T) a la trajectoire et la projection de la consigne sur 

ladite tangente et 

- fournir lesdites consignes de mouvement (500) k un 
moyen d' asservissement (601-606) qui permet de mettre en 

25 mouvement au moins un axe dudit robot (600) conformement 
auxdites consignes de mouvement (500) . 

2. Procede selon la re vendi cations 1, caracterise en ce 
que ledit signal d' effort exterieur (800) est calcule a 
partir d'une information representant le courant circulant 

30 dans au moins un actionneur (601-606) dudit robot (600) . 

3. Precede selon I'^xone des revendi cat ions precedentes, 
caracterise en ce qu'il comprend une etape consistant & 
utiliser un modele dynamique (712) dudit robot (600) lors du 
calcul dudit signal d' effort exterieur (800) . 
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4. Precede selon I'une des revendications prgc^dentes, 
caracterise en ce qu'il comprend une gtape consistant a 
fournir audit generateur de trajectoire (400) au moins une 
valeur limite de vitesse (330) et/ou une valeur limite 
d' acceleration (340) pour prise en compte lors du calcul 
desdites consignes de mouvement (500) , de telle sorte que 
lesdites consignes soient conforme a ladite ou auxdites 
valeurs limites. 

5. Dispositif de coiranande des dgplacements d'une partie 
mobile d'un robot multiaxes le long d'une trajectoire, 
caracterise en ce qu'il comprend : 

- un g^n^rateur de trajectoire (400) apte a calculer des 

consignes de mouvement (500) en fonction d' instructions de 

mouvements (3 00) incluant au moins des informations relatives 

15 a la geometrie de la trajectoire (320) et a des consignes 
d' effort (310) et ^ 

- un estimateur d' effort (700) apte a ggn^rer un signal 
d' effort exterieur (800) representant au moins une composante 
de 1' effort (F) exerce par ladite partie mobile (O) sur son 
environnement et a fournir ledit signal audit generateur de 
trajectoire, a une frequence d' ^chantillonnage predeterminee, 
alors que ledit generateur de trajectoire est apte a calculer 
lesdites consignes de mouvement (500) , a une frequence 
d'gchantillonnage predeterminee, de fa(?on a minimiser I'^cart 
entre la projection (Ft) de 1' effort exterieur sur la tangente 
(T) a la trajectoire et la projection de la consigne d' effort 
sur ladite tangente, lesdites consignes de mouvement (500) 
etant foumies a un moyen d' asservissement (601-606) 
permettant de mettre en mouvement au moins un axe dudit robot 

30 (600) . 

6. Dispositif selon la revendication 5, caract^risg en 
ce qu'il comprend un moyen interprSteur de programme (200) 
apte a executer des programmes qui comportent des 
instructions de mouvement (300) permettant de specifier au 
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moins la ggom^trie de la trajectoire (320) et des consignes 
d' effort (310) . 
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